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(57)Abstract: 

PURPOSE: To make a robot walk stably even it moves on a place where 
two or more of planes such as rough terrain, etc. continue by providing a 
means to determine a walking so that a ZMP position obtained by 
dynamics is positioned at a set ZMP target position. 
CONSTITUTION: When a surface to be walked by a robot includes at 
least two planes of No.1 and No.2, a virtual No.3 plane which varies 
continuously from the No.1 plane to the No.2 plane is assumed. Next, a 
ZMP target position of the robot is set virtually on it. Then a walking of 
robot is determined so that the ZMP position obtained by dynamics is 
positioned at the set ZMP target position to move the ZMP continuously 
even if the planes are different from each other. Here the ZMP means a 
point on a floor at which a moment caused by floor reaction in walking 
becomes zero. Thus the robot can walk stably even on rough terrains. 
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<tt(j)4Lfc©-e. 3|s:^Bgcc$^tt©ei^2S^ff©iP^ 
#«)a^ 7 I- i^^T^mtiii: 2 -:5Ji(±©5pB;&sig,^-r-5« 

50 m^miitht^i>. s^bfc^^rMfT.5c<h:*ir 
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[0 06 1] fi5j5ii3^K*o-c«. -enicjii 

1 , H 2 ©^l»^c < i 2 ocDTS^Sr^t? i 

ia» 2 ^micmm-r^mmomyjoy^cmDm 2 o^m^ 

1 ©¥M*>6IS2cD^ffiCCigi^W(c^{b'r€.<KSW^cll 

■o -c** 6 z M p (ssd^sfrtas!^ $ nfc z M p 

i 2 olitJi(DiFffi*sjl^^^it^=S:^t(j-r ^ i * . 

[0 06 2] smm4m<ommc$,':>xit. wmm i . 

m2©SJ6®8^tftBE*C>,'^i€rM,'^,i-r-Slll . »2©ffi 

[ 0 0 6 3 ] ff5Rra5IH©^StC*)->r«. HfriaZMP 

u4<y h tc^S)^c}slttI^i^^As^s.-t^ 
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* [02 ] s 1 iC7fk-rmm=i-:^ -j h©^Bj:/p i^m-Oi 
[03] c(Dmni'C%^m^^W}niiiv v(D^m^^ 

10 -ri^BjHr*^, 

[08] 03:7a- • g^i-- h-cfflusHM^tcffiffl 

[010] CCD^H^CCJ;SJj£5BLfcZMP«,^*fflo-C 

2 Ji(±©ii^-r ^¥®cc^^-r s z M p ^^^-1*^8^0-0 
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V V) 
2 

1 0 R. 

1 2 R, 
1 4R, 
1 6 R, 

1 8 R, 

2 0 R. 
2 2 R, 
2 4 

2 6 

3 6 



1 0 L mmmmm(omm 

1 2 L mm(ovi-}\y:f^\^(DmB 

1 4 L JggBCD fc' ^:^fpI<DMgi5 

1 6 L SlSBOfc' ^^^f^OMSB 

1 8 L JSmSPcZ) >y ^:^f^©Mgp 

2 0 L smspco n -;t':^fSi(DMgp 
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[H3] 



C START ~^ S10 



$6MM^ ( E 0 ) , ^ 1 ^' 


( E 1 ) ,m2J 


^ E 2 ) 1^ 








^ S12 


// 2 // (22 




u 1 +E 1 Z 1 
Q2+E2Z2 (ui: 
( t s ~ t e ) 












IS 1 1 (Ell) (DIS^ . 155^ 
u 11 =u 1 +E 1 Z 1 








^ 


%Z 1 ( E 2 1 ) OD^^ . iE5E 
u 2 1 ==u2 + E222 










( E 3 1 ) 
U31={h(u21+E 
+ ( U 1 1 +E 1 


21Z2)-(u11+E11Zl)J 
1 Z 1 ) 




( h = ( t-t s )/( t e-t s ) ) 












{fi3&ZMP3!)^IS3 1 mmikCi^i^^W ( U 3 1 ) 








C END ) 
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ZMPBWJ 
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Gc = (go^, gey. gcz) 

Gcd = (gcdx, gcdy. gcdz; ^mit^^m 

Gcdd ^ (gcddx. gcddy. 9Cddz) 

mi J>'7 i ©HH 

Gel = (gcix, gciy. gciz) 'J^i? i ©M'C^ 

Gcdi cgcdix. gcdiy, gcdiz) u>7 i <oa)C»s« 

Gcddi = (gcddix, gcddiy, gcddiz) u>7 i Q)m<MiD%d 

Ji = diOfl(Jix, Jiy, Jiz) ^r^o \ ©Ittt^^^VJKifiltt) 
wi = (wix. wiy, wiz) >J>7 i tDA%a 
wdi = (wdix, wdiy. wdiz) g>7 i <Dft»ss 



— flyi^x* Lwy« Lwz) 
Lwd = (Lwdx. Lwdy. Lwdz) ^<9ft^«i 



LV = IGciXGcdi *U>i7(tja italic J:© Ji/j£*»iJ(J!) 

- CLVX. Lvy, Lvz) ^ZMft^llffi 
LVd = (LVdx. Lvdy, LVdz) =t0m^% 

g = (O^O.gz) ■*ta«S'^^?hjKg2=-9.8m/s*) 



FaO+mg=mGcdd 


Newton eq. 


■ 


MaO+Gcx(mg)=Lwd+Lvd 


EaLer eq. 





